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基于 改进 粒子 群 算法 的 四 旋翼 自 抗 扰 控 制 器 优化 设计 
胡 丹 丹 ， 张 字 搬 


(中 国民 航 大 学 机 器 人 研究 所 ,天津 300300) 


摘 要 : 针对 四 旋翼 飞行 器 自 抗 扰 控制 器 参数 较 多 ， 人 工整 定 困难 且 难以 得 到 最 优 控 制 效果 的 问题 ， 提 出 一 种 基于 改 
进 粒 子 群 算法 的 四 旋 辟 自 抗 扰 控制 器 优化 方法 。 在 设计 了 四 旋 要 飞 行 器 的 自 抗 扰 控制 器 之 后 ， 将 自 抗 扰 控制 器 的 参数 
作为 粒子 群 中 的 粒子 进行 选 代 寻 优 ， 同 时 在 传统 的 粒子 群 算法 基础 上 ， 参 考 遵 传 算法 ， 对 适应 值 不 好 的 粒子 进行 交叉 
保 优 ， 以 提高 粒子 的 多 样 性 ， 加 快 寻 优 速度 。 仿 真 结果 表明 ,对比 人 工整 定 参数 的 控制 器 ,优化 后 的 控制 器 超 调 更 
调节 时 间 更 快 。 该 方法 能 够 解决 四 旋翼 飞行 器 自 抗 扰 控 制 器 人 工 参数 整定 困难 的 问题 ， 且 优化 后 的 控制 器 具有 更 好 的 
控制 效果 。 
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ADRC controller optimization design based on Improved PSO algorithm for quad-rotor 


Hu Dandan, Zhang Yuchen 
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Es 和 Abstract: In order to solve the problem that the parameters of quad-rotor aircraft ADRC controller are difficult to set, and it is 


hard to get the optimal control effect due to manual parameter tuning, this paper proposed a design method of adaptive 


disturbance rejection controller based on improved particle Swarm optimization for quad-rotor After designed the ADRC 


controller of quad-rotor, this method iteratively optimized the parameters of the controller as particles in the particle Swarm. At 


the same time, based on the traditional particle Swarm optimization and referring to genetic algorithm, it cross-guaranteed the 
particles with poor fitness value to Improve the diversity of particles, and to speed up the search Speed. The Simulation results 
Show that compared with the controller with manual tuning parameters, the optimized controller has less overshoot and faster 
adjusting time. This method can solve the difficulty of manual parameter setting of quad-rotor aircraft ADRC controller, and the 
optimized controller has better control performance. 

Key words: quad-rotor aircraft; active disturbance rejection controller( ADRC); particle swarm optimization(PSO); parameter 


optimization; attitude control 


计 了 基于 神经 网 络 的 自 适应 动态 反 转 控制 器 .Raffo 等 四 在 2015 
年 提出 了 一 种 用 于 四 旋 辟 飞行 器 路 径 跟 踪 的 非 线性 鲁 棒 控 和 


0 引言 


一 


策 


四 旋 经 飞行 器 的 控制 系统 是 一 个 四 输入 、 六 输出 的 欠 驱 动 略 ， 仿 真 结果 表明 该 方法 具有 良好 的 鲁 棒 性 。 
非 线性 系统 ， 有 具有 强 耦 合 性 特点 ， 难 以 建立 精确 模型 且 易 受到 诸如 LQR、 重 棒 控 制 、 反 步 控制 等 59 控制 策略 虽然 有 比较 
外 界 干 捧 ， 因 此 ， 其 优化 设计 成 为 近年 来 国内 外 学 者 研究 的 热 ”好 的 效果 ， 但 由 于 其 控制 算法 或 需要 基于 准确 的 数学 模型 ， 或 
点 和 难点 。 计算 量 很 大 ， 数 据 的 实时 处 理 对 处 理 器 性 能 要 求 高 ， 实 现 起 来 
Gonzalez-vazquez 等 人 [ 叫 于 2010 年 基于 经 典 PID 控制 方法 ， 有 一 定 的 困难 。 目 前 各 类 四 旋翼 飞行 器 依然 是 使 用 传统 串 级 


采用 非 线性 PID 控制 器 实现 了 四 旋翼 飞行 器 的 姿态 控制 和 位 置 。 PID 作为 核心 控制 算法 ，PID 算法 对 于 控制 精度 不 高 的 飞行 任 
控制 。Alothman 等 人 外 于 2015 年 提出 了 一 种 基于 LQR 的 四 旋 。 务 可 以 基本 满足 控制 需求 ， 但 是 其 抗 干扰 能 力 差 ， 且 无 法 满足 
辟 飞 行 器 载荷 运输 系统 的 设计 方法 ， 仿 真 结果 表明 控制 效果 优 ， ”高 精度 的 控制 需求 。 

于 传统 PID 控制 器 。Yang 等 人 中 提出 了 一 种 基于 动态 逆 的 四 旋 为 了 提高 飞行 器 的 抗 干扰 性 ， 学 者 们 开始 使 用 自 抗 扰 技 术 
翼 飞 行 器 非 线性 控制 方法 。 为 了 补偿 该 方法 所 产生 的 误差 ， 设 ”来 设计 旋 辟 控制 器 -9， 相 比 于 传统 串 级 PID 控制 器 拥有 更 好 
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粒子 群 算法 i 


四 旋 收 飞行 器 数学 模型 建立 


选取 和 型 四 旋翼 机 型 建立 数学 模型 


进行 寻 
入 局 部 最 优 的 问题 加 入 遗传 算法 


空 制 器 参数 较 多 ， 整 定 困难 。 为 了 得 
且 解 决 人 工 参数 整定 困难 的 问题 ， 本 文 首 先 
扰 技术 设计 了 四 旋 辟 飞行 器 控制 器 ， 对 于 
包 ， 同 时 对 于 粒子 群 算法 易 陷 
的 交叉 保 优 思想 进行 改进 。 


自 抗 扰 控 种 


Pc 


标 系 和 机 体 坐 标 系 ， 如 


建立 坐标 系 。 


图 1 所 示 。 
惯性 坐标 系 ECOXYZ) 相 对 于 地 球 表 
(ENU) 
机 体 坐 标 系 B (oxyz) 与 飞行 器 固 


为 1 号 与 3 号 电机 夹 角 的 角 平 分 线 方向 ,oy 轴 


号 与 3 号 电机 夹 角 的 f 
机 体 上 方 ， 该 坐标 系 符 


2 号 电机 


合 右手 


平分 线 方向 , ox 轴 
定 则 。 


型 。 定 义 两 个 坐标 系 : 惯 


看 不 动 , 取 “ 东 北 天 ” 


联 ， 原 点 为 飞行 器 的 重 


垂直 于 oxy 平面 


4 号 电机 


图 1 


惯性 坐标 系 与 机 体 坐 标 系 示意 


图 


考虑 到 四 旋翼 飞行 器 的 气动 环境 复杂 ， 且 易 受 到 未 知 的 外 


界 干 
下 几 


质量 


式 : 


点 假设 : 


重合 . 


飞行 器 的 各 姿态 角 定 义 


滚 转角 


合 ， 吕 由 于 飞行 器 不 会 飞 的 很 高 
， 飞 行 器 所 受 重力 和 阻力 不 受 飞行 器 飞行 高 度 变化 的 影 
自转 与 公转 对 飞行 器 的 影响 。 
图 2 所 示 。 


球 


如 


俯仰 角 


扰 ， 为 了 方便 模型 的 建立 ， 对 飞行 器 不 失 一 般 性 地 作出 如 
a) 视 四 旋翼 飞行 器 为 均匀 对 称 刚 体 ， 飞 行 过 程 中 
保持 不 变 ; 唱机 体 坐 标 系 的 原点 与 飞行 器 几何 中 心 及 质心 
始终 重 
为 平面 
响 , 始终 保持 不 变 ; d) 不 计算 地 


很 远 ， 所 以 视 地 球 表面 


图 2 飞行 器 姿态 


3 示意 图 


8=(cosgsingcos 多 +sin 儿 sin W) 芭 UV 
$=(cosgsinOsiny +sin Geosy) 


. ts 


基于 以 上 设 定 ， 四 旋 姻 飞行 器 动力 学 模型 可 表示 为 如 下 形 


二 一 


六 


其 中 : p,9,w 分 别 为 滚 转 角 、 
了， 8 为 重力 加 速度 ， 
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定义 Ui ~ Ui 为 各 个 通 
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道 的 控 各 


| 量 ， 表 述 如 下 : 


UD=R+h+b+h=kh(Q + + +0) 


U,=-h+bh+h-b=k(-2 + +0 -02) 


U=-h+b-b+h=k(-2+0 -0 +20) 


Us=h+th-h-h=b(Q + -0 -0) 


1 为 旋翼 中 心 到 机 体 坐 标 系 原 点 的 距离 ， 
力 ， 人 2 ~ 人 2 为 对 应 
旋 辟 的 阻力 系数 。 亿 ,4 和,4, 消 ,4 分 别 表示 各 个 通道 


和 干扰 部 分 。 
2 ”四 旋 曙 飞行 
2.1 


俯仰 角 和 偏 航 角 ，m 为 飞行 器 的 
太公 分别 为 三 个 轴 上 的 转动 惯量 ， 


~ 为 对 应 旋 咽 升 
机 的 转速 ， 为 旋 咽 的 升力 系数 ， 为 


首 未 建 模 


器 自 抗 扰 控制 器 设计 


自 抗 扰 控制 器 结构 设计 


抗 扰 控制 技术 (active disturbance rejection controller， 


ADRC ) 是 韩 京 清 教授 于 上 世纪 80 年 代 末 期 提出 的 一 种 新 的 控 
制 理论 090， 其 特点 是 不 依赖 于 控制 对 象 的 模型 ， 可 以 将 系统 建 
模 不 准确 产生 的 “内 扰 ” 和 系统 外 部 扰动 结合 起 来 进行 估计 补 
偿 。 其 结构 包括 跟踪 微分 器 (TD)、 扩 张 状态 观测 器 (ESO) 和 
非 线 性 误差 反馈 控制 律 C(NLSEF) 三 个 部 分 。 二 阶 自 抗 扰 控制 
器 结构 如 图 3 所 示 。 


四 旋翼 飞行 器 高 度 与 姿态 控 


| | | 


图 3 


下 ) 一 人 被 皖 对 象 一 一 
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二 阶 


抗 扰 控制 器 结构 图 


制 结构 图 如 


4 所 示 。 
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图 4 


! 旋 辟 飞 行 器 高 度 与 姿态 


室 制 结 


构图 


姿态 控制 是 飞行 器 可 以 稳定 飞行 的 基础 ， 由 飞行 器 动力 学 


模型 可 知 ,四 旋 辟 的 姿态 角 通 道 耦合 在 一 起 构成 了 飞行 器 的 “内 
扰 ” 这 可 以 通过 设计 扩张 状态 观测 器 来 进行 估计 补偿 , 从 而 实 
现 解 看 控制 ， 使 得 各 个 通道 变 为 “积分 串联 器 ”型 的 线性 系统 
1。 姿 态 系统 方程 如 下 : 
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将 上 式 整理 为 自 抗 扰 理论 对 应 的 形式 : 


| [f (8,0,w,4) U, 
人 =| £ ($0,y,4)|+BIU, 
y| LA($,0,y,4) U, 


ey 
0 f=0y 3 二 水 


全 


Y 


其 中 : B=| 0 万 0 |， 
了 | | 
L. | 7 上 4 


2.2 自 抗 扰 控制 器 算法 设计 

以 四 旋翼 飞行 器 的 深 转 通道 为 例 来 描述 自 抗 扰 控 制 器 的 设 
计 过 程 。7 为 控制 器 的 控制 间隔 。 

1) 跟踪 微分 器 (TD) 

TD 可 以 为 输入 信号 安排 过 渡 过 程 ， 并 提取 输入 信号 的 微 
分 ， 表示 如 下 : 


vi(k+l)=v (kK)+Ty, (k) 


vw (k+l) Vy (kK)+Tfst(v (Kk)—va,v, (K),7,h) 


其 中 v 是 期 望 值 ，r 为 速度 因子 ，h 为 滤波 因子 ， 提 高 7 值 可 
以 减 小 安排 过 渡 过 程 的 时 间 ， 过 大 的 7 值 会 使 得 跟踪 信号 更 加 
逼近 输入 信号 ， 但 会 失去 安排 过 渡 过 程 的 意义 。 滤 波 因子 刀 可 
以 滤 掉 跟踪 信号 中 的 噪声 ，h 越 大 滤波 效果 越 好 ， 但 是 增 大 
会 产生 输入 信号 相位 损失 , 一 般 来 讲 h 设 定 为 3-10 倍 的 控制 周 
朋 。 

2) 扩张 状态 观测 器 (ESO) 

ESO 对 系统 的 总 扰动 进行 估计 ， 并 且 实 时 补偿 给 控 和 
其 表示 如 下 : 


和 


器 ， 


a=z (kK)—y(k) 
a(k+l)=a (A)+7( (£)-Bs) 
zk+1)=z(k)+T(z(k)-p,fal(s,0,6)+bu(k)) 
za(k+1)=z(k) -Th,fal(s,0,,6) 


其 中 :wo02 决定 fal(。) 的 非 线 性 程度 ， 一 般 的 ，Q 取 0.5，Q 
取 0.25。 5 为 伺 (*) 函数 在 原点 附近 的 线性 区 间 宽 度 , 如 果 5 太 
大 会 降低 ESO 对 于 非 线性 型 号 的 逼近 能 力 , 过 小 的 5 会 导致 高 
频 震 荡 。 ,BB,,B 为 状态 误差 反馈 的 反馈 增益 ， 影响 ESO 的 收 
敛 速度 。ph 越 大 跟踪 输入 信号 的 速度 越 快 。 同样 的 ， 记 越 大 
2 跟踪 输入 信号 的 速度 越 快 。 关系 着 观测 器 对 于 扰动 估计 
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旋 辟 飞行 器 无 法 精确 建 模 的 特性 , 可 以 将 5b 作为 一 个 可 调 参 数 。 
算法 中 fal(*) 和 fst(*) 表示 如 下 : 


fal(s,a,5) 二 >0 


€ 
Oi? la < 0， 


ro 
mt |e 


rsign(a),le|>d 


1/2 


d=rhd,=dh,y=%+h,0=(d? +8r|y|) 


+ 2 ,|y|> a 
C= 


+ 了 < 


抗 扰 控 制 器 不 依赖 模型 ， 不 需要 针对 具体 被 控 对 象 来 分 
析 系 统 的 稳定 性 ， 只 需 选 取 适 当 参 数 ， 就 可 以 实现 四 旋 辟 飞行 
器 姿态 和 高 度 的 稳定 控制 。 


3 ”基于 改进 粒子 群 算法 的 自 抗 扰 控 制 器 参数 优化 


粒子 群 算法 (particle swarm optimization，PSO) 是 计算 智 
能 领域 的 一 种 群体 智能 优化 算法 , 由 Kennedy 和 Eberhart 博士 
在 1995 年 提出 的 (> 中 ,该 算法 已 广泛 的 应 用 于 众多 领域 的 参数 
寻 优 问题 1 司 。 粒 子 群 算法 速度 与 位 置 更 新 公式 表示 如 下 : 

wa (E+D) = (+an (ps -za (0) 
ton (pa -za(k)) 
za (K+1)=za (Kk)+va (k+l1) 
其 中 : 为 迭代 次 数 ，z; 为 第 i 个 粒子 ，d 为 每 个 粒子 的 维度 ， 
Di 为 粒子 迄今 搜索 到 的 最 后 位 置 ，P, 为 整个 粒子 群 迄今 搜索 
到 的 最 优 位 置 ，ci,c, 为 粒子 的 学 习 因 子 ， 使 得 粒子 具有 自我 ， 
结 和 向 群体 中 优秀 粒子 学 习 的 能 力 ，% 为 粒子 惯性 权重 ， 起 着 
权衡 局 部 最 优 和 全 局 最 优 的 作用 ，,5 为 [0,1j 之 间 的 随机 数 ， 
使 得 群体 具有 多 样 性 。 
传统 的 粒子 群 算法 是 通过 追随 个 体 极 值 和 群体 极 值 来 完成 
寻 优 的 ， 虽 然 操 作 简 单 ， 且 能 够 很 快 的 收敛 但 是 随 着 迭代 次 
数 的 增加 ， 在 收敛 的 同时 ， 各 粒子 越 来 越 相 似 ， 可 能 在 局 部 解 
周边 无 法 跳出 。 为 了 解决 粒子 群 算法 在 进行 寻 优 计算 过 程 中 陷 
入 到 局 部 最 优 的 问题 ， 借 鉴 遗 传 算法 ， 在 粒子 每 次 人 迄 代 寻 优 的 
过 程 中 加 入 选择 、 交 又 操作 以 对 粒子 群 算法 进行 改进 ， 使 得 算 


下 


产生 的 滞后 ，B; 越 大 产生 的 滞后 越 小 。, 记 ,三 个 参数 之 间 
相互 制约 ， 增 大 有 ,ps 能 够 抑制 B 过 大 产生 的 震荡 。 
3) 非 线 性 误差 反馈 控制 律 (NLSEF ) 
NLSEF 中 反馈 误差 以 非 线 性 的 组 合计 算 控 和 


a =v(k)-z(k) 
三 (£)—z (x) 


uo (k)=h fal(e, ,0,)+k, fal(e,, 0&,,0,) 


OS EA) 


b 
NLSEF 中 要 满足 0< a <1<&%, 的 条 件 ， 一 般 取 ww 为 0.75， 
0 为 1.2$。0 的 调节 与 ESO 中 的 一致。 三越 大 系统 响应 越 
快 ，k, 可 以 抑制 系统 的 超 调 。2 由 系统 状态 方程 决定 ， 对 于 四 


上 量 , 表示 如 下 : 


法 可 以 遍历 到 更 多 的 粒子 。 具 体 为 : 每 一 次 迭代 后 计算 粒子 群 
适应 值 的 算术 平均 值 ， 取 适应 值 大 于 算术 平均 值 的 最 大 偶数 个 
粒子 直接 进入 下 一 次 迭代 ， 将 剩余 粒子 进行 遗传 算法 中 的 交叉 
选择 操作 ， 随 机 选取 需要 交叉 的 位 数 ， 并 对 粒子 对 应 位 进行 交 
又 ， 将 交叉 后 生成 的 子 代 与 父 代 结 合 在 一 起 并 比较 适应 值 ， 选 
择 适 应 值 更 好 的 一 半 进 入 下 一 次 迭代 ， 生 成 新 一 组 粒子 群 。 

算法 的 适应 度 函 数 选 取 ITAE 误差 准则 ， 其 值 越 低 ， 性 能 
越 好 ， 基 本 形式 如 下 : 


J =|, de 
在 自 抗 扰 控制 器 中 有 14 个 可 调 参 数 ， 其 中 ESO 中 的 
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B, 忆 ,PB; 和 NLSEF 中 的 ,k,b 是 控制 器 最 关键 的 6 个 参数 ， 


前 者 决定 扰动 的 估计 补偿 能 力 ， 后 者 直接 决定 控制 量 
自 抗 扰 控制 器 


本 文 将 这 6 个 参 
粒子 群 算法 。 


数 作为 粒子 群 算法 的 粒子 ， 设 计 


改进 粒子 群 算法 的 流程 如 下 所 述 


a) 初 始 化 粒子 群 ， 随 机 产生 所 有 粒子 的 位 


的 大 小 ， 


定 粒子 的 p; 和 P。; 


和 速度 ， 并 确 


胡 丹 丹 ， 


控 玮 


上 器 进行 比较 ，ADRC 控制 器 仿 
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期 刊 
优 


模块 如 图 


6 所 示 : 


了 9 
NCSEF " 


y 


ESO 


ESO 


< 


b 


图 6 Matlab/Simulink 中 ADRC 仿真 模块 


b) 按 照 粒 子 群 速度 与 位 置 公式 更 新 粒子 的 速度 和 位 置 ; 
o) 将 每 个 粒子 代入 控制 器 仿真 器 并 计算 对 应 的 TTAE 值 。 仿真 实验 以 滚 转 通道 为 例 ， 旋 翼 自 身 参数 如 表 1 所 示 。 
i 粒 平均 值 ， 个 国 
d) 计算 所 有 粒子 ITAE 值 的 算术 平均 值 ， 取 偶数 个 ITAE 
值 小 于 平均 值 的 粒子 直接 进入 下 一 次 迭代 。 剩 余 粒 子 进 行 交 又 站 千 
选择 ， 生 成 相同 数量 的 子 代 ， 并 与 父 代 一 起 进行 排序 , 取 ITAE 本 15 
值 更 小 的 一 半 进 入 下 一 次 迭代 。 Dae We 
g/l(m/s 4 
6) 将 每 一 个 粒子 的 适应 值 与 该 粒子 所 经 历 过 的 最 优 位 置 aa 33 
p; 的 适应 值 进行 比较 ， 如 果 更 好 ， 则 将 该 粒子 其 作为 新 的 p; 1,/ (kg em) 0.033 
对 每 个 粒子 ,将 其 适应 值 与 整个 粒子 群 所 经 历 过 的 最 优 位 置 7 “0 ee 
的 适应 值 进行 比较 ， 如 果 更 好 ， 则 将 该 粒子 作为 新 的 P, ; Extw 
信 如 果 没 有 满足 最 终 条件 〈 适 应 值 小 于 预 设 阔 值 或 者 超过 
最 大 和 迭代 次 数 )， 则 返回 步骤 b)， 否则， 退出 算法 ,输出 寻 优 过 选取 控制 周期 为 0.018，ADRC 参数 如 表 2 所 示 。 
时 曲线 和 最 优 解 。 表 2 ADRC 仿真 参数 
使 用 改进 的 粒子 群 算法 对 于 自 抗 扰 控制 器 的 参数 进行 优化 ， 模块 参数 数值 
其 过 程 如 图 5 所 示 。 2 ee 
ESO pb 100 
人 /内 A 450 
pb, 2900 
产生 粒子 条 a 0.5 
粒子 依次 赋值 给 控制 器 人 0.25 
证 O 0.1 
运行 ADRC 控 制 器 模型 NLSEF k 80 
te k, 40 
ao, 0.75 
Ca 1.25 
Oo 0.1 
b 
设 定期 望 深 转 角度 为 15 度 ， 分 别 仿真 PID 和 ADRC 两 种 
本 控制 器 得 到 的 输出 曲线 如 图 7 所 示 , 控制 性 能 指标 如 表 3 所 示 ， 
图 5 PSO 算法 流程 图 
从 图 中 可 以 看 出 自 抗 扰 算法 超 调 量 小 于 串 级 PID 控制 器 且 调 节 
关于 惯性 权重 w , 较 高 的 w 会 使 PSO 拥有 更 好 的 全 局 搜索 。 时 间 更 短 。 
能 力 ， 而 低 o 值 则 对 于 局 部 搜索 更 加 有 利 0q。 为 了 使 得 粒子 群 
算法 在 计算 初期 具有 更 好 的 全 局 搜索 能 力 ， 而 在 计算 后 期 具有 or < 
更 好 的 局 部 寻 优 能 力 ， 现 将 中 设置 为 如 下 动态 形式 : fi -一 呈 
w(Kk) = Wo 一 (ww od) 去 | Ee 10 
其 中 ，@w( 有 为 第 上 次 迭代 时 的 惯性 权重 ， wwr 为 惯性 权重 初 注 中 | 


始 值 , 通常 设 定 为 0.9， 


Ta 为 最 大 迭代 次 数 。 
4 ”实验 分 析 


Qo 为 惯性 权重 终 值 , 通常 设 定 为 0.4， 


本 文 首先 建立 四 旋翼 ADRC 控制 器 模型 并 与 传统 串 级 PID 


2 3 4 5 6 第 8 


仿真 时 间 /s 


7 ADRC/PID 控制 效果 对 比 
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控制 性 能 指标 对 比 


控制 器 


超 调 /% 


调节 时 间 /s 


串 级 PID 
自 抗 扰 控制 


3.09 
1.64 


5.89 
2,31 


为 了 测试 ADRC 控 


高 斯 


噪声 ， 其 控制 效果 如 


判 器 的 抗 了 
图 8 所 示 。 


飞行 器 稳定 状态 下 , 在 5s 时 
号 来 测试 两 种 


F 扰 输入 信 
9 所 示 。 


加 入 高 斯 噪声 后 ADRC/PID 


空 制 器 的 抗 


真 时 间 /s 
空 制 效果 对 比 


刻 加 入 幅 


图 9 加 入 突变 噪 


实验 表明 ，ADRC 


有 


仿真 时 间 /s 


声 后 ADRC/PID 控制 效果 对 比 


优秀 的 噪声 抑制 和 抗 干扰 能 力 。 
之 后 ， 加 入 改进 粒子 群 对 ADRC 参数 进行 优化 ， 对 粒子 群 


算 


A 


去 的 各 项 参数 进行 设 定 ， 


体 数值 如 表 4 所 示 。 


4 PSO 参数 设 定 


值 为 1、 脉 宽 为 1s 


F 扰 能 力 , 对 两 种 控制 器 加 入 


干扰 能 力 ， 控 制 效 果 如 


Da 


参数 数值 [6,k,5b,B,B,B] 
a 2 
c 2 
粒子 维度 6 
粒子 群 规模 50 
最 大 办 代 次 数 50 
粒子 速度 上 限 [1,1,0.25,1,2,5] 
粒子 速度 下 限 [-1,-1,-0.25,-1,-2,-5] 
粒子 寻 优 上 限 [400, 400, 30, 200,1000, 4000] 
粒子 寻 优 下 限 [141,40.60,200,1500| 
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以 四 旋 辟 滚 转角 通道 为 例 ， 其 他 参数 设 定 保持 不 变 ， 只 进 


,kk,b,Bi,B,,B; 的 优化 ,以 15 度 作 为 输入 ,优化 后 与 之 前 参 


数 的 各 性 能 指标 如 表 5 所 示 。 


表 5 滚 转角 优化 前 后 参数 与 控制 性 能 对 比 

优化 前 优化 后 

局 100 94.13 

pb, 450 437.89 
pb, 2900 2930.31 

hk 80 253.48 

大 40 212.15 

b 5 9.87 

超 调 /% 2.31 0.32 
调节 时 间 /s 1.64 1.25 
ITAE 性 能 0.0145 0.0016 

各 个 参数 的 变化 曲线 与 优化 之 后 的 仿真 结果 如 图 10~13 所 
示 。 
800 k1,k2,b 优 化 曲线 


参数 值 


0 10 20 30 40 50 
过 代 次 数 


图 10 ,k,b 优化 曲线 
b1,b2,b3 优 化 曲线 
3000 机 
| 一 1 
! Sr b2 
2000| -一 -23 
pn| | 
流 
人 
1000 
| 
0 
0 10 20 30 40 50 
迭代 次 数 
图 11 pb,p,,pP; 优 化 曲线 
总 最 优 个 体 适 应 值 
0.08 
迎 0.06 
Ll 
导 0.04 
0.02 
0 


0 10 20 30 40 50 
迁 代 次 数 


图 12 


ITAE 适应 值 曲 线 
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由 
仿真 时 间 /s 
图 13 ”优化 前 后 的 深 转 角 控制 曲线 
俯仰 角 通 道 的 特性 与 滚 转角 相近 ， 可 以 使 用 相同 的 参数 ， 
不 再 另行 优化 。 航 偏 角 和 高 度 分 别 输入 60 和 5， 优化 前 后 的 参 


数 分 别 如 表 6、7 所 示 ， 对 比 曲线 分 别 如 


区 


表 6 航 偏 角 优 化 前 后 参数 与 控 和 


14、15 所 示 。 


记性 能 对 比 


优化 前 优化 后 
bh 100 112.45 
pb 450 609.71 
bs 3000 3532.56 
hk 100 288.14 
kb 80 256.2 
b 15 23.41 
超 调 /% 3.23 0.79 
调节 时 间 /s 2.75 2.11 

一 

3 4 5§ 8 7 8 9 0 

仿真 时 间 /s 
图 14 ”优化 前 后 的 航 偏 角 控制 曲线 

表 7 高 度 优化 前 后 参数 与 控制 性 能 对 比 
优化 前 优化 后 
bh 100 127.14 
pb, 450 771.28 
bs 3000 4000 
大 120 322.4 
访 100 335.21 
b 20 25.63 
超 调 /% 3.68 0.8 
调节 时 间 /s 4.36 3.42 
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一 一 一 优化 后 
= 二 傣 化解 


5 6 水 8 9 10 


仿真 时 间 /s 


0 1 2 3 


图 15 优化 前 后 的 高 度 控制 曲线 


通过 仿真 实验 可 以 看 出 ， 经 过 改进 PSO 算法 优化 后 的 


ADRC 控制 器 超 调 更 且 调 节 时 间 更 短 ， 同 时 无 顷 人 工 调 参 。 和 


滚 转角 通道 类 似 ， 俯 仰角 通道 、 航 偏 角 通道 和 高 度 通 道 的 挖 于 


一 


效果 经 过 改进 PSO 算法 优化 后 也 具有 很 好 的 效果 。 因 此 使 用 改 


进 粒子 群 算法 对 ADRC 控制 器 进行 参数 优化 明 是 一 种 行 之 有 
效 的 方法 。 
5 ”结束 语 


本 文 首先 设计 了 基于 自 抗 扰 控 制 技术 的 四 旋 跨 飞行 器 姿态 


与 高 度 控 制 器 ， 为 了 得 到 最 优 控制 效果 ， 并 针对 自 抗 扰 控 制 器 


参数 较 多 ， 人 工整 定 耗 时 长 且 难 以 达到 最 优 的 问题 ， 提 出 了 基 


于 粒子 群 算法 的 自 抗 扰 控 制 器 参数 优化 方法 ， 同 时 为 了 解决 粒 


子 群 算法 易 陷 入 局 部 最 优 的 问题 ,加 入 遗传 算法 中 的 交叉 操作 ， 


对 适应 值 不 好 的 粒子 进行 交叉 保 优 ， 以 提高 粒子 的 多 样 


性 ， 加 


上 


H 


快 寻 优 速度 。 使 用 Simulink 对 整个 优化 过 程 进 行 了 仿真 ， 结 果 
表明 , 使 用 改进 的 PSO 算法 , 能够 有 效 解决 自 抗 扰 控 制 器 人 工 
参数 整定 困难 的 问题 , 经 过 改进 的 PSO 算法 优化 后 的 自 抗 扰 控 


短 ， 


制 器 具有 更 好 的 动态 特性 和 稳 态 特性 ， 且 算法 简单 ， 


参 时 间 


5 昌 


易于 实现 ， 具 有 较 大 的 实际 应 用 价值 。 
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